import numpy as np


def get_distance_between_points(pos1, pos2):
    return np.sqrt((pos1[0] - pos2[0]) ** 2 + (pos1[1] - pos2[1]) ** 2 + (pos1[2] - pos2[2]) ** 2)


def degreeToRadians(x):
    return x / 360 * 2 * np.pi


def radiansToDegree(x):
    return 360 * (x / (2 * np.pi))


O1 = [5000, 2000, 2000]
O2 = [4000, 3000, 2500]
O3 = [3000, 4000, 3000]
R = 1000

for theta in [degreeToRadians(i * 72) for i in range(5)]:
    Po1x = O1[0] + R * np.cos(theta)
    Po1y = O1[1] + R * np.sin(theta)
    print(Po1x, Po1y, O1[2])

print(2 * np.pi * R / 400)
